// Mission example:

#define WP_RADIUS 25 		// What is the minimum distance to reach a waypoint?

#define LOITER_RADIUS 45 	// How close to Loiter?

#define HOLD_CURRENT_ALT 0	// 1 = hold the current altitude, 
							// 0 = use the defined altitude to for RTL

#define ALT_TO_HOLD	30		// If you entered 0, altitude to hold above home in meters
							// If you entered 1, just leave this as the default, 30


// command byte, p1, altitude, latitude, longitude
float mission[][5] = {
{CMD_WAYPOINT, 			0, 				40, 	37.622354, -122.378007},		// WP
{CMD_RELAY, 			1, 				0, 		0, 0},						// Set relay to B position
{CMD_SERVO, 			CH_4,	 		1900, 	0, 0},					// move channel 4 to 1900µs
{CMD_REPEAT, 			CH_4_TOGGLE, 	1100, 	5000, 0},		// move channel 4 to from current PWM to 1100 , every 5 seconds, indefinitly
{CMD_DELAY, 			0, 				0, 		30000, 0},					// delay 30 seconds
{CMD_REPEAT, 			STOP_REPEAT, 	0, 		0, 0},				// stop repeating
{CMD_SERVO, 			CH_4, 			1500, 	0, 0},					// move channel 4 to 1500µs
{CMD_REPEAT, 			RELAY_TOGGLE, 	0, 		3000, 0},			// toggle relay every 5 seconds, indefinitly
{CMD_DELAY, 			0, 				0, 		30000, 0},					// delay 30 seconds
{CMD_REPEAT, 			STOP_REPEAT, 	0, 		0, 0},				// stop repeating
{CMD_WAYPOINT, 			0, 				40, 	37.622354, -122.378007},		// WP
};
